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THE  SIMNET  ROTATION  MATRIX 
Technical  Report 

Publication  Number  IST-TR-89-4 


INTRODUCTION 

In  this  Technical  Report  we  present  a  description  of  the  nine  element  (3  x  3) 
rotation  matrix  used  in  the  SIMNET  Vehicle  Appearance  Protocol  Data  Unit  (VA 
PDU)  to  describe  a  vehicle's  orientation  (attitude)  in  free  space.  Also  included 
is  a  program  (written  in  Microsoft  C)  which  calculates  this  matrix  given  a 
vehicle's  pitch,  roll,  and  yaw  angles  (in  degrees). 

SIMNET  COORDINATE  SYSTEMS 

If  we  are  to  understand  the  vehicle  rotation,  some  knowledge  of  the  SIMNET 
coordinate  systems  is  necessary.  There  are  two  coordinate  systems  in  the 
SIMNET  system;  world  and  vehicle  (hull)  coordinate  systems. 


•  World  Coordinates  (Figure  1);  The  origin  of  this  coordinate  system  is 
located  at  the  Southwest  corner  of  the  terrain  data  base.  The  Y-axis  points 
North,  the  X-axis  East,  and  the  Z-axis  Up. 


Figure  1 .  SIMNET  World  Coordinates 


•  Hull  Coordinates  (Figure  2):  The  Y’-axis  points  out  of  the  front  of  the 
vehicle,  the  X'-axis  points  through  the  right  side  of  the  vehicle,  and  the  T- 
axis  points  through  the  top  of  the  hull.  The  Computer  Image  Generator 
(CIG)  system  relies  on  hull  coordinates  as  a  basis  for  computing  all  display 
views. 


Figure  2  shows  the  angles  p,  r,  and  y, which  the  hull  of  the  vehicle  makes  with 
the  world  coordinate  system.  These  angles  correspond  to  the  pitch,  roll,  and 
yaw  angles  (respectively)  that  define  the  vehicles  orientation,  and  are  used  in 
the  calculation  of  the  rotation  matrix  described  in  the  subsequent  discussion. 

j  *  a  * 
a  \ 

Jj*t  T  * 


V 


f 


Figure  2.  Pitch,  Roll,  and  Yaw  Angles 


ROTATION  MATRIX  DESCRIPTION 

The  orientation  of  a  vehicle  is  constantly  changing  as  it  traverses  the  battlefield. 
As  a  result,  new  pitch,  roll,  and  yaw  angles  must  be  continually  computed  and 
transmitted  across  the  network.  The  SIMNET  Vehicle  Appearance  PDU 
requires  a  nine  element  rotation  matrix  to  describe  the  vehicles  orientation. 

The  method  used  by  SIMNET  rotates  the  vehicle  coordinate  system  from  the 
"old"  frame  of  reference,  into  the  "updated"  frame.  A  maximum  of  three  angle 
rotations  is  sufficient  to  bring  any  two  frames  into  coincidence.  The  three 
rotations  are  performed  about  the  X,  Y,  and  Z  axes  using  the  following  matrices: 


Rotation  about  the  x-axis:  Rotation  about  the  y-axis:  Rotation  about  the  z-axis: 
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Each  matrix  represents  rotation  about  a  certain  axis;  "p"  is  the  pitch  angle 
(rotation  about  the  X  world  coordinate  axis),  T  is  the  roll  angle  (rotation  about 
the  Y-axis),  and  "y"  is  the  yaw  angle  (rotation  avout  the  Z-axis).  All  angles  are 
expressed  in  radians  for  the  matrix  calculations.  Upon  performing  matrix 
multiplication  on  X,  Y,  and  Z,  the  resulting  matrix  is: 
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The  elements  of  R  are  given  by: 

Rii  =  cos(r)  cus(y) 

R12  =  -  cos(r)  sin  (y) 

R13  =  sin(r) 

R21  =  cos(p)  sin(y)  +  sin(p)  sin(r)  cos(y) 

R22  =  cos(p)  cos(y)  -  sin(p)  sin  (r)  sin(y) 

R23  =  -  sin(p)  cos(r) 

R31  =  sin(p)  sin(y)  -  cos(p)  sin  (r)  cos(y) 

R32  =  sin(p)  cos(y)  +  cos(p)  sin  (r)  sin(y) 

R33  =  cos(p)  cos(r) 

ROTATION  PROGRAM 

We  generated  a  Microsoft  C  program  that  calculates  the  rotation  matrix  R.  With 
this  program  it  is  possible  to  input  a  desired  orientation  (by  providing  angles  for 


pitch,  roll,  and  yaw)  and  have  the  matrix  elements  calculated  and  placed  in  the 
matrix  array.  A  copy  of  this  program  is  provided  in  Appendix  A. 

LOCATION  OF  ROTATION  DATA  IN  VEHICLE  APPEARANCE  PDU 

The  SIMNET  Vehicle  Appearance  PDU  contains  the  rotation  matrix  that  is 
broadcast  to  other  SIMNET  vehicles  on  the  network.  The  exact  location  of  the 
rotation  information  is  in  octets  15  through  50  of  the  VA  PDU.  The  elements  of 
the  rotation  matrix  (Rn,  R12, ....  R33)  are  placed  in  order,  starting  with  octets  15 
through  18  being  Rn.  Each  element  is  four  octets  long,  therefore  the  matrix 
adds  up  to  a  total  of  36  octets  (bytes). 

Element 

Octet. ft 

R11 

15-18 

Rl2 

19-22 

Rl3 

23-26 

R2i 

27-30 

R22 

31-34 

^23 

35-38 

R31 

39-42 

R32 

43-46 

47-50 

The  information  given  in  this  report  is  in  concurrence  with  SIMNET  Software 
Version  5.25.  This  software  is  the  current  version  which  resides  in  the  SIMNET 
Ml  modules  located  in  the  IS!  laboratories. 
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APPENDIX  A 


SIMNET  ROTATION  MATRIX  SOFTWARE  PROGRAM 


r 


/*  This  program  computes  the  rotation  matrix  (3x3)  for  the  SIMNET  PDU's 
rriven  the  pitch,  roll  and  yaw  of  the  vehicle  in  degrees.  Final  results 
are  stored  in  matrix  B.  */ 

main ( ) 

{ 

#include  <stdio.h> 

# include  <math.h> 

ir.t  i  j  ,  k=0 : 
float  R, P, Y; 

float  RC,RS,PC,PS, YC, YS; 
float  A  [3]  [3]; 
float  B  [3]  [3]; 
float  z  [3]  [3]; 
float  x  [ 3 ]  ( 3  j ; 
float  y  [3]  [3]? 

/*  Input  the  rotation  angles  */ 

printf("\n  Enter  Roll  Pitch  Yaw  in  degrees\n") ; 

scanf ("%f  %f  %f",&R,  &P,  &Y) ; 

printf  ("Roll=%5 . 2f  Pitch=%5 . 2f  Yaw=%5.2f\n",R,P,Y); 

R= (R*3 . 14) /180 ;  /*  Convert  angles  from  degrees  to  radians  */ 

P=(P*3.14)/180; 

Y=(Y*3.14)/180; 

RC=cos(R) ;  /*  Calculate  sines  and  cosines  */ 

RS=sin (R) ; 

PC=cos(P) ; 

PS=sin(P) ; 

YC=cos (Y)  ; 

YS=sin(Y)  ; 

printf ("sin  R=%7.6f  cos  R=%7 . 6f\n" ,RS,RC) ; 
printf ("sin  Y=%7.6f  cos  Y=%7.6f\n",YS,YC) ; 
printf ("sin  P=%7.6f  cos  P=%7 . 6f \n" , PS, PC) ; 

z [ 0 ]  [0]=YC;  /*  Generate  x,  y,  and  z  rotation  matrices  */ 

2(0]  [1]— YS; 
z(0]  [ 2 ] =0 ; 
z [ 1 ]  ( 0 ] =YS ; 

2(1]  [1]=YC; 
z(l]  ( 2 ] =° ; 

z [ 2 ]  [0]=0 ; 

2(2]  [ 1 ]=0 ; 

2(2]  [2]=1 ; 


x(0]  [0]=l; 
x(0]  [l]=o; 
x(0]  [2 ]=0 ; 

A-l 


x(l]  [  0  ]  =  0 ; 
x[l]  [ 1 ] =  PC ; 
x [ 1 ]  ( 2 ] =-PS ; 

x  ( 2  ]  f  0  ]  =  0  ; 
x(2]  [  1  ] =PS ; 
x[ 2 ]  [ 2 ] =  PC ; 


y [ 0 ]  [ 0 ] =RC ; 

y[0]  [ 1 ]=0 ; 
y[0]  [ 2 ] =RS ; 

y  [  1  ]  [  0  ]  =  0  ; 
y[i]  [i]-i; 
y [ 1]  [ 2 ] =0 ; 

y[2]  [ 0 ]=-RS ; 
y [ 2 ]  C i] =o ; 
y [2 ]  [23=RC; 

/*  multiply  x  matrix  by  y  matrix  and  put  results  in  matrix  A  */ 

for  (i=0 ; i<=2 ; i++) { 
for  ( j=0; j<=2 ; j++) { 

A[i3  C j  3=o; 

for  (k=0 ;k<=2 ;k++) 

A [ i 3 [ j ]  +=  x[i][k3  *  y[k][j]; 

} 

) 

/*  Display  matrix  A  results  */ 

for  (i=0?i<=2;i++) { 
for  ( j=0; j<=2 ? j++) 

printf ("A[%d3 [ %d  3  =%5.4f  " , i, j , A[ i] [ j ] ) ; 

printf ("\n") ; 

} 

/*  Multiply  matrix  A  by  z  matrix  and  store  in  B  matrix  */ 

for  ( i=0 ; i<=2 ; i++) { 
for  ( j  =0  ? j<=2; j++) { 

B[i] [ j  3=0; 

for  (k=0;k<=2 ;k++) 

B C i 3 [ j ]  +=  A[i][k]  *  z[k] [ j ] ; 

) 

} 

printf ("\n\n")  ; 

/*  Display  final  B  matrix  results  */ 


for  (i=0;i<=2;i++) { 
for  ( j=0; j<=2 ; j++) 

printf ("B(%d][%d3  =  %5.4f  " , i, j , B[ i] [ j 3 ) ; 

printf ("\n") ; 

) 
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